clc
clear
%%
%定义前弹向量
co_source = [0;0;20];

%定义普通向量
co_common = [0;0;2];

%定义指示向量矩阵
vec_sum = [0;0;0];

%定义节点坐标矩阵
or_all = [0;0;0];
%%
%获取各节点欧拉角信息，并表示为矩阵
euler_matrix = rand(3,97);

%第一个数传包坐标点确定
vec_1_x = pitch_rotate(euler_matrix(1,1),co_source);
vec_1_y = yaw_rotate(euler_matrix(2,1),vec_1_x);
vec_1_end = rolls_rotate(euler_matrix(3,1),vec_1_y);
or_1 = vec_1_end;
vec_sum = [vec_sum,vec_1_end];   %更新指示向量
or_all = [or_all,or_1];          %更新节点坐标矩阵

%%
%开始递推
for i = 2:97
    vec_i_x = pitch_rotate(euler_matrix(1,i),co_common);
    vec_i_y = yaw_rotate(euler_matrix(2,i),vec_i_x);
    vec_i_end = rolls_rotate(euler_matrix(3,i),vec_i_y);
    vec_sum = [vec_sum,vec_i_end];    %更新指示向量
    or_i = sum(vec_sum,2);
    or_all = [or_all,or_i];           %更新节点坐标矩阵
end
